import robo3pi as s
import serial
import time
import math
import functions as f


#Define Params
COM_NUM = '3'
ID = '2'
edgeLength = 0.21
timePerEdge = 1


s.init('COM' + COM_NUM) # this is the com the xbee dongle identified itself on my computer.
f.rotateByAngle(ID, -90)
#f.moveInLine (ID, -0.25 , 0.1)
#time.sleep(2);
#f.stop()
#f.rotateByAngle(ID, 90)



#f.rotateByAngle(ID, 90) # Rotate towards point 3
#time.sleep(0.5)


s.close()